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@ Einmessvorrichtung und Verfahren zum Einmessen eines Arbeitspunktes von Werkzeugen fur Industrieroboter 



Eine Einmessvorrichtung (1) zum Einmessen eines Ar- 
beitspunktes (TCP) von Werkzeugen (13) fur Industriero- 
boter (8) hat mehrere sich in einem Referenz-Kreuzungs- 
punkt (R) kreuzende Lichtschranken (5a, 5b). 
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Beschreibung Werkzeugspitze in einem Basiskoordinatensystem be- 

stimmt. Darin wird der Einstellpunkt des Handflansches auf 

[0001] Die Erfindung betrifft eine Einmessvorrichtung die Referenzspitze aufgesetzt und die Position und Orientie- 

zum Einmessen eines Arbeitspunktes von Werkzeugen fur rung des Einstellpunktes in dem Koordinatensystem des 

Industrieroboter sowie ein Verfahren zum Einmessen eine 5 Handflansches bestimmt. Zudem wird die Position und Ori- 

Arbeitspunktes von Werkzeugen fur Industrieroboter mit ei- eotierung der Referenzspitze in dem Bezugskoordinatensy- 

ner solchen Messvorrichtung. stem bestimmt und aus den drei Matrizen eine Transforma- 

[0002] Industrieroboter haben zum Anfahren beliebiger tionsmatrix zur Bezeichnung der TCP-Lagekoordinaten des 

Punkte innerhalb eines Arbeitsraums mehrere miteinander Arbeitspunktes des Werkzeuges berechnet. 

verbundene Arme, einen Handflansch am Ende des letzten to [0009] Das Einmessen erfordert einen mehrstufigen Ver- 

Arms der miteinander verketteten Arme, und ein Werkzeug, fahr-Vorgang sowie Koordinatentransformationen. 

das an den Handflansch angebracht ist. Das Werkzeug kann [0010] Aus dem US-Patent 6,352,354 Bl ist ein Licht- 

beispielsweise ein Greifer, ein Schweifikopf oder ahnliches punktelement zur Erzeugung eines Lichtpunktsignals an ei- 

sein. nem Arbeitspunkt eines Industrieroboter-Werkzeugs be- 

[0003] Die Lage und Orientierung des Handflansches oder 15 schrieben. Hierdurch kann die genaue Position des Werk- 

des Arbeitspunktes eines an den Handflansch angebrachten zeugs wahrend einer Lernphase beschrieben werden. 

Werkzeugs kann in einem ortsfesten roboterunabhangigen [0011] In dem US-Patent 5,929,584 ist ein Verfahren zum 

Weltkoordinatensystem oder einem ortsfesten auf einen Ver- Einmessen eines Arbeitspunktes von Werkzeugen mit einem 

ankerungspunkt des Industrieroboters bezogenen Basisko- Kalibrierblock beschrieben, der vertikale und horizontale 

ordinatensystem erfolgen. Die Beschreibung der Lage der 20 Flachen hat. Durch Bewegung des Werkzeugs von einer 

Freiheitsgrade, d. h. der Achsen und der Handorientierung Startposition bis zu einem Beriihrungspunkt des Werkzeugs 

erfolgt hingegen in Roboterkoordinaten, wobei ausgehend an einer der Flachen und Zuriickfahren des Werkzeugs zum 

von der Grundachse des Roboters, d. h. des Basiskoordina- Startpunkt und Wiederholen des Vorgangs fur die andere 

tensystems, fur jeden Arm ein Achsen-Roboterkoordinaten- Flache werden die TCP-Lagekoordinaten des Arbeitspunk- 

system definiert ist, das die relative Lage jeder Achse bezo- 25 tes berechnet. Hierzu ist nachteilig eine aufwandige Koordi- 

gen auf ihre vorgehende Achse beschreibt. Der Zusammen- natentransformation von dem Bezugskoordinatensystem 

hang der Achsen-Roboterkoordinatensysteme eines Indu- iiber die einzelnen Roboterkoordinaten bis zu dem Hand- 

strieroboters wird durch definierte Koordinatentransforma- flansch erforderlich, um aus den Bezugskoordinaten die 

tionen beschrieben. Durch Vorgabe der Lage und der Orien- TCP-Lagekoordinaten im TCP- Koordinatensystem zu er- 

tierung des Handflansch oder des Arbeitspunktes eines 30 mitteln. 

Werkzeugs im Weltkoordinatensystem konnen somit durch [0012] Aufgabe der Erfindung war es, eine verbesserte 

Koordi natentransformation die Achsen-Roboterkoordinaten Einmessvorrichtung zum Einmessen eines Arbeitspunktes 

berechnet werden, um die einzelnen Achsen des Industriero- von Werkzeugen fUr Industrieroboter sowie ein Verfahren 

boters ansteuem zu konnen. hierzu zu schaffen, um im Betrieb prazise und schnell den 

[0004] Die Lage eines Arbeitspunktes eines Werkzeuges, 35 Arbeitspunkt von Werkzeugen einmessen zu konnen. 

das an den Handflansch des Industrieroboters angebracht [0013] Die Aufgabe wird mit der gattungsgem&Ben Ein- 

wird, wird durch sogenannte TCP-Lagekoordinaten be- messvorrichtung erfindungsgemaB dadurch gelost, dass die 

schrieben. Die Programmierung des Industrieroboters er- Emmessvorrichtung mehrere sich in einem Referenz-Kreu- 

folgt auf der Basis des Handflanschs und der festgelegten zungspunkt kreuzende Lichtschranken hat. 

TCP-Lagekoordinaten. Die TCP-Lagekoordinaten werden 40 [0014] Im Unterschied zu den herkommlichen Kalibrier- 

bei jedem Werkzeug mitgeliefert und sind als Tool-Center- blocken mit horizontalen und vertikalen Flachen kann eine 

Point (TCP) bekannt. Die TCP-Lagekoordinaten sind solche Einmessvorrichtung mit Gabellichtschranken relativ 

ebenso wie die Achsen-Roboterkoordinaten jeweils ein Vek- klein und leicht aufgebaut und fest im Arbeitsraum des In- 

tor mit sechs Dimensionen. Die ersten drei Koordinaten de- dustrieroboters montiert werden. Im Betrieb kann der Ar- 

finieren die Lage des Arbeitspunktes relativ zu dem Werk- 45 beitspunkt des Werkzeugs, in der Regel die Werkzeugspitze, 

zeugbasispunkt des Industrieroboters, d. h. des Befesti- in den Referenz-Kreuzungspunkt der Lichtschranken gefah- 

gungspunktes des Werkzeugs an dem Handflansch. Die an- ren werden, um die TCP-Lagekoordinaten (Tool-Center- 

deren drei Koordinaten definieren die Orientierung der Ach- Point-TCP) neu einzumessen. 

sen des Arbeitspunktes relativ zu dem Werkzeugbasispunkt. [0015] Hierzu hat die Lichtschrankenmesseinrichtung 

[0005] Der Arbeitspunkt des Werkzeugs kann beispiels- 50 vorzugsweise einen auf einer Seite offenen Rahmen mit 

weise die Spitze eines SchweiBkopfes sein. Nur wenn die zwei voneinander beabstandeten parallelen Schenkeln. Min- 

TCP-Lagekoordinaten exakt bekannt sind, kann der Arbeits- destens im Bereich des vorderen und hinteren Endes der 

punkt des Werkzeugs prazise verfahren werden. Schenkel ist jeweils ein Sender und Empfanger fUr zwischen 

[0006] Im Betrieb kann sich der Arbeitspunkt des Werk- den Schenkeln zu dem Rahmen ausgerichtete Lichtschran- 

zeugs jedoch durch WerkzeugverschleiB, Verbiegung etc. 55 ken vorgesehen. Das Werkzeug kann somit in diese U-fdr- 

andem, was zu einer fehlerhaften Positionierung des Ar- mige Einmessvorrichtung hineingefahren und solange dort 

beitspunktes des Werkzeugs fiihrt. verfahren werden, bis der Arbeitspunkt, d. h. die Werkzeug- 

[0007] Es besteht daher die Notwendigkeit den Arbeits- spitze des Werkzeuges den Referenz-Kreuzungspunkt pas- 

punkt von Werkzeugen hochgenau einzumessen. siert und beide Lichtschranken unterbrochen sind und dem- 

[0008] In der EP 0 417 320 Al ist ein Verfahren zum Ein- 60 zufolge ein Schaltsignal abgeben. Dann werden die TCP- 

messen des Arbeitspunktes (TCP) des Werkzeuges eines In- Lagekoordinaten ermittelt. 

dustrieroboters beschrieben, bei dem ein Einstellpunkt an [0016] Die Lichtschranken sind vorzugsweise als Infrarot- 

dem Handflansch des Roboterarms festgelegt ist, wobei die Lichtschranken ausgefuhrt Das Einmessen des Arbeits- 

Position des Einstellpunktes relativ zu dem Handflansch be- punktes erfolgt vorzugsweise mit den Schritten: 

kannt ist. Weiterhin ist eine Referenzspitze im Arbeitsraum 65 

des Industrieroboters aufgestellt. Zum Einmessen des Ar- a) Festlegen der TCP-Lagekoordinaten des Arbeits- 

beitspunktes wird die Spitze des Werkzeugs auf die Refe- punktes des Werkzeuges bezogen auf einen Werkzeug- 

renzspitze aufgesetzt und die Position und Orientierung der basispunkt des Industrieroboters und eines auf den Ar- 
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beitspunkt bezogenen TCP-Koordinatensystems, 

b) Verfahren des Werfczeuges mit Bezug auf das TCP- 
Koordinatensystem solange, bis der Arbeitspunkt des 
Werkzeuges in dem Referenz-Kreuzungspunkt der 
Lichtschrankenmesseinrichtung liegt, 

c) Korrigieren der TCP-Lagekoordinaten um die Dif- 
ferenz zwischen den festgelegten TCP-Lagekoordina- 
ten und der beim Verfahren des Werkzeuges in Bezug 
auf das TCP-Koordinatensystem unmittelbar im TCP- 
Koordinatensystem vorliegenden Lage des Arbeits- 
punktes in dem Referenz-Kreuzungspunkt. 

[0017] ErfindungsgemaB wird somit vorgeschlagen, das 
Werkzeug in Bezug auf das TCP-Koordinatensystem zu ver- 
fahren, d. h. die Steuerung erfolgt nicht wie herkdmmlich 
auf der Basis des Weltkoordinatensystems oder Basiskoor- 
dinatensystems des Industrieroboters, sondern unmittelbar 
mit Bezug auf TCP-Koordinatensystem. Das TCP-Koordi- 
natensystem hat in der Regel semen Ursprung im Arbeits- 
punkt, beispielsweise der Messspitze des Werkzeugs, und 
erne Orientierung m Richtung des Werkzeugbasispunktes, 
beispielsweise des Befestigungspunktes des Werkzeugs an 
dem Handflansch. 

[0018] Auf diese Weise wird erreicht, dass die Steue- 
rungsposition des Industrieroboters unmittelbar auf das 
TCP-Koordinatensystem bezogen ist und ohne weitere 
Transformationen die Verschiebung des Arbeitspunktes re- 
lativ zu den vorher festgelegten TCP-Lagekoordinaten des 
Arbeitspunktes bestimmt werden kann. Es wird somit die 
Verschiebung des Referenz-Kreuzungspunktes bezogen auf 
den Ursprung des TCP-Koordinatensystems bestimmt, wo- 
bei der Ursprung des TCP-Koordinatensystems in der Regel 
den Arbeitspunkt eines neuwertigen Werkzeuges beschreibt. 
Die TCP-Lagekoordinaten konnen somit unmittelbar ohne 
weitere Transformation zur Korrektur der vorher festgeleg- 
ten TCP-Lagekoordinaten verwendet werden. 
[0019] Diese Vorgehensweise fiihrt einerseits dazu, dass 
zum Einmessen lediglich ein einfacher Referenz-Kreu- 
zungspunkt im Arbeitsraum des Industrieroboters definiert 
werden muss. Die Einmessvorrichtung kann somit relativ 
einfach im Vergleich zu einem Kalibrierblock aufgebaut 
werden. Zudem ermoglicht das Verfahren das schnelle und 
emmalige Anfahren des Referenz-Kreuzungspunktes durch 
die Werkzeugspitze, um eine Korrektur der TCP-Lagekoor- 
dmaten bei VerschleiB, Verbiegung oder ahnliches des 
Werkzeuges vorzunehmen. Dies wird auf einfache Weise 
nur dadurch erreicht, dass das Werkzeug zum Einmessen im 
TCP-Koordinatensystem gefiihrt wird. Der Ursprung des 
TCP-Koordinatensystems, d. h. der Arbeitspunkt des Werk- 
zeugs wird auf dem friiher festgelegten Arbeitspunkt statio- 
nar gehalten und es werden somit die Basiskoordinaten des 
Referenz-Kreuzungspunktes der Lichtschrankenmessein- 
richtung in Bezug auf den friiher festgelegten Arbeitspunkt 
vermessen. 

[0020] Die Erfindung wird nachfolgend anhand der beige- 

fiigten Zeichnungen naher erlautert. Es zeigen: 

[0021] Fig. 1 perspektivische Ansicht einer erfindungsge- 

maBen Einmessvorrichtung mit zwei sich kreuzenden Licht- 

schranken; 

[0022] Fig. 2 Draufsicht auf die Einmessvorrichtung nach 
Fig. 1, 

[0023] Fig. 3 Skizze eines Industrieroboters mit mehreren 
Armen und Basiskoordinatensystem sowie Achsenkoordi- 
natensystemen; 

[0024] Fig. 4 Skizze der Verlagerung des Arbeitspunktes 
eines Werkzeugs nach VerschleiB in Bezug auf ein TCP-Ko- 
ordinatensystem. 

[0025] Die Fig. 1 lasst eine erfindungsgemaBe Einmess- 



vorrichtung 1 in perspektivischer Ansicht erkennen. Die 
Einmessvorrichtung 1 hat einen auf einer Seite offenen Rah- 
men 2 mit zwei voneinander beabstandeten parallelen 
Schenkeln 3a, 3b. Die Einmessvorrichtung 1 ist somit U- 
5 formig. Die Schenkel 3a, 3b sind integral mit einer Halte- 
platte 4 verbunden, mit der die Einmessvorrichtung 1 orts- 
fest in dem Arbeitsraum des Industrieroboters montiert wer- 
den kann. 

[0026] In den Schenkeln 3a, 3b sind diagonal hierzu aus- 
to gerichtete Lichtschranken 5a, 5b vorgesehen, die sich in ei- 
nem Referenz-Kreuzungspunkt R im Zwischenraum zwi- 
schen den Schenkeln 3a, 3b treffen. Hierzu ist jeweils em 
Sender 6 und ein Empfanger 7 pro Lichtschranke 5a, 5b an 
emem vorderen Ende eines ersten Schenkels 3a und am hin- 
ts teren Endes des anderen Schenkels 3b fur die erste Licht- 
schranke 5a bzw. an dem hinteren Ende des ersten Schen- 
kels 3a und dem vorderen Ende des zweiten Schenkels 3b 
fur die zweite Lichtschranke 5b angebracht. Auf diese 
Weise wird eine Gabellichtschranke geschaffen, die vor- 
20 zugsweise als Infrarot-Lichtschranke ausgebildet ist. 

[0027] Die Fig. 2 lasst die Einmessvorrichtung 1 in der 
Draufsicht erkennen. Es wird deutlich, dass die Lichtschran- 
ken 5a, 5b diagonal zwischen den Schenkeln 3a und 3b ver- 
laufen und sich im Zwischenraum der Schenkel 3a, 3b in ei- 
25 nem Referenz-Kreuzungspunkt R treffen. 

[0028] Ein Arbeitspunkt TCP eines Werkzeugs fur einen 
Industrieroboter, beispielsweise die Werkzeugspitze, wird 
zum Einmessen des Arbeitspunktes TCP so verfahren, dass 
der Arbeitspunkt TCP in dem Referenz-Kreuzungspunkt R 
30 der Einmessvorrichtung 1 liegt. In diesem Falle sind beide 
Lichtschranken 5a, 5b durch die Werkzeugspitze unterbro- 
chen, so dass ein Schaltsignal erzeugt wird. 
[0029] Das Einmessverfahren wird im Folgenden nSher 
erlautert. 

35 [0030] Die Fig. 3 lasst eine Skizze eines Industrieroboters 
8 erkennen. Ein Industrieroboter 8 hat ein Basiskoordinaten- 
system Do oder Weltkoordinatensystem, das ortsfest m Be- 
zug auf das Fundament des Industrieroboters 8 ausgerichtet 
ist. An dem Sockel 9 befindet sich eine Kette von iiber Ge- 

40 lenke 10 miteinander verbundene Arme 11. Fur jeden dieser 
Arme 11 ist ein Achsen-Koordinatensystem OiA, O3 defi- 
niert, mit dem Position und Orientierung des jeweiligen En- 
des des entsprechenden Arms 11 in Bezug auf das zugeord- 
nete Gelenk 10, mit der Arm 11 mit dem vorhergehenden 

45 Arm 11 verbunden ist, beschreibt. 

[0031] An dem Ende der Kette von Armen 11 befindet 
sich eine Handflache 12, an die das Werkzeug 13 angebracht 
ist. 

[0032] Fur das Werkzeug 13 ist ein TCP-Koordinatensy- 
50 stem Orcp festgelegt, das einen Ursprung in dem Arbeits- 
punkt TCP des Werkzeugs hat. Fur das Werkzeug 13 werden 
auf der Basis dieses TCP-Koordinatensystems Prep TCP- 
Lagekoordinaten bereitgestellt, die die Position und Orien- 
tierung des Arbeitspunktes TCP in Bezug auf den Werk- 
55 zeugbasispunkt W am Handflansch 12, d. h. in Bezug auf 
den Befestigungspunkt des Werkzeugs 13 an dem Industrie- 
roboter 8 definiert. 

[0033] Um die TCP-Lagekoordinaten im Betrieb bezogen 
auf den Werkzeugbasispunkt W des Industrieroboters 8 

60 schnell und mit geringen Rechenaufwand einmessen zu 
konnen, wird erfindungsgemaB die Werkzeugspitze des 
Werkzeugs 13 hi den Referenz-Kreuzungspunkt R der orts- 
fest montierten Einmessvorrichtung 1 auf der Basis des 
TCP-Koordinatensystems Otcb verfahren. Es erfolgt somit 

65 eine auf den Arbeitspunkt TCP bezogene Interpolation des 
Verfahrweges beim Fiihren des Werkzeugs 13 durch den In- 
dustrieroboter 8. Der Ursprung des TCP-Koordinatensy- 
stems Otcp wird hierbei stationar in Bezug auf die festgeleg- 
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ten TCP-Lagekoordinaten des Arbeitspunktes TCP gehal- 
ten. Aus dem Verfahrweg kann direkt die Verschiebung des 
Arbeitspunktes TCP bei VerschleiB oder Verbiegen des 
Werkzeugs 13 in den TCP-Koordinaten bestimmt werden. 
Es wird also quasi eine Verschiebung des Referenz-Kreu- 5 
zungspunktes R in Bezug auf einen urspriinglichen Refe- 
renz-Kreuzungspunkt R TC p bestimmt. Damit entfallt die 
Notwendigkeit, aufwandige Koordinatentransformationen 
durchzufiihren und es braucht lediglich wie in einem Schritt 
der Referenz-Kreuzungspunkt R angefahren werden. 10 
[0034] Die Fig. 4 lasst das Werkzeug 13 mit dem TCP- 
Koordinatensystem &tcp erkennen, dass seinen Ursprung 
im Arbeitspunkt TCP des Werkzeugs 13 hat. Fur den Fall 
der skizzierten Verkriimmung des Werkzeuges verlagert 
sich der Arbeitspunkt TCPi in Bezug auf den vorher festge- is 
legten urspriinglichen Arbeitspunkt TCP 0 . Die TCP-Lage- 
koordinaten sind um diese Verschiebung ATCP 0 = TCP t - 
TCP 0 zu korrigieren. Da erfindungsgemaB die Steuerung des 
Industrie-Roboters 8 in Bezug auf das TCP-Koordinatensy- 
stem Otcp erfolgt, wird die Differenz zwischen den ur- 20 
spriinglich festgelegten TCP-Lagekoordinaten TCPo und die 
Lage des neuen Arbeitspunktes TCPi eines verschlissenen 
Werkzeugs 13 unmittelbar ermittelt. 

Patentanspriiche 25 

1. Einmessvorrichtung (1) zum Einmessen eines Ar- 
beitspunktes (TCP) von Werkzeugen furlndustrierobo- 
ter (8), dadurch gekennzeichnet, dass die Einmess- 
vorrichtung (1) mehrere sich in einem Referenz-Kreu- 30 
zungspunkt (R) kreuzenden Lichtschranken hat. 

2. Einmessvorrichtung (1) nach Anspruch 1, dadurch 
gekennzeichnet, dass die Einmessvorrichtung (1) einen 
auf einer Seite offenen Rahmen mit zwei voneinander 
beabstandeten parallelen Schenkeln (3a, 3b) hat, wobei 35 
mindestens im Bereich des vorderen und hinteren En- 
des der Schenkel (3a, 3b) jeweils ein Sender und Emp- 
fanger fur zwischen den Schenkeln (3a, 3b) diagonal zu 
dem Rahmen ausgerichtete Lichtschranken (5a, 5b) 
vorgesehen sind. 40 

3. Einmessvorrichtung (1) nach Anspruch 1 oder 2, 
dadurch gekennzeichnet, dass die Lichtschranken (5a, 
5b) Infrarot-Lichtschranken sind. 

4. Verfahren zum Einmessen eines Arbeitspunktes 
(TCP) von Werkzeugen (13) fur Industrieroboter (8) 45 
mit der Einmessvorrichtung (1) nach einem der vorher- 
gehenden Anspruche, gekennzeichnet durch 

a) Festlegen der TCP-Lagekoordinaten des Ar- 
beitspunktes (TCP) des Werkzeuges (13) bezogen 
auf einen Werkzeugbasispunkt (W) des Industrie- 50 
roboters (8) und eines auf den Arbeitspunkt (TCP) 
bezogenen TCP-Koordinatensystems, 

b) Verfahren des Werkzeuges (13) mit Bezug auf 
das TCP-Koordinatensystem solange, bis der Ar- 
beitspunkt (TCP) des Werkzeuges (13) in dem Re- 55 
ferenz-Kreuzungspunkt (R) der Einmessvorrich- 
tung (1) liegt, 

c) Korrigieren der TCP-Lagekoordinaten um die 
Differenz zwischen den festgelegten TCP-Lage- 
koordinaten und der beim Verfahren des Werkzeu- 60 
ges (13) in Bezug auf das TCP-Koordinatensy- 
stem unmittelbar im TCP-Koordinatensystem 
vorliegenden I,age des Arbeitspunktes (TCP) in 
dem Referenz-Kreuzungspunkt (R). 
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